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The Rectilinear Control System can be used to simulate a launch vehicle during liftoff. Several control 
schemes have been developed that can control different dynamic models of the rectilinear plant. A robust 
control algorithm was developed that can control a pendulum to maintain an inverted position. A fluid slosh 
tank will be attached to the pendulum in order to test robustness in the presence of unknown slosh 
characteristics. The rectilinear plant consists of a DC motor and three carts mounted in series. Each cart’s 
weight can be adjusted with brass masses and the carts can be coupled with springs. The pendulum is 
mounted on the first cart and an adjustable air damper can be attached to the third cart if desired. Each cart 
and the pendulum have a quadrature encoder to determine position. Full state feedback was implemented in 
order to develop the control algorithm along with a state estimator to determine the velocity states of the 
system. A MATLAB program was used to convert the state space matrices from continuous time to discrete 
time. This program also used a desired phase margin and damping ratio to determine the feedback gain 
matrix that would be used in the Lab VIEW program. This experiment will allow engineers to gain a better 
understanding of liquid propellant slosh dynamics, therefore enabling them to develop more robust control 
algorithms for launch vehicle systems. 


Nomenclature 

m, = mass of cart one 

m 2 = mass of cart two 

m p = mass of pendulum 

k = spring constant 

Ci = friction acting on cart one 

C 2 = friction acting on cart two 
F f = force of friction 

L = length of the pendulum arm 

g = gravitational constant 

x = state vector 

x = state estimate vector 

y = output vector 

y = output estimate vector 


I. Introduction 

T he Rectilinear Control System can be used to simulate a launch vehicle during liftoff by the use of the two cart 
system and the inverted pendulum. A control algorithm for the two cart system was developed in order to 
simulate the coupling of a multi-stage rocket. This algorithm controls the position of the first cart with the added 
disturbance of the second cart coupled with a spring. 
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Once a control algorithm is developed that will maintain the pendulum in an inverted position, a liquid slosh tank 
will be attached to the pendulum to test for robustness in the presence of unknown slosh characteristics. This 
experiment will provide engineers a cost effective simulation of a rocket, therefore enabling them to develop more 
robust control algorithms for launch vehicle systems. 


II. Overview of the Model 210a Rectilinear Control System 

The Model 210a Rectilinear Apparatus is designed to provide insight to control system principles through hands- 
on demonstration and experimentation '. The rectilinear plant consists of a DC motor and three carts mounted in 
series. The cart weight can be adjusted with brass masses and the carts can be coupled with different sized springs. 
The A-5 1 Pendulum Accessory is mounted on the first cart for the lower pendulum and the inverted pendulum 
systems. The pendulum length and location of the point mass can be adjusted. An optional disturbance motor can be 
attached to any cart and an adjustable damper can be attached to the third cart if desired. Each cart and the pendulum 
have a high resolution quadrature encoder to determine position. A fluid slosh tank has been constructed that can be 
attached to the pendulum in order to test for robustness in the presence of slosh dynamics. This attachment will 
enable engineers to simulate fuel slosh present in liquid propellant launch vehicles. 



Figure 1. Rectilinear Control System 


Originally, the Rectilinear Control System contained a data acquisition board which executed the control 
algorithm and collected data from the experiment. However, this board is no longer functioning and has been 
replaced with a Lab VIEW user interface and Peripheral Component Interconnect (PCI) cards. Lab VIEW is an icon 
based programming language which enables the user to make programming structures rather than lines of code. The 
PCI cards are located within the computer and allow the computer to access the data output from the system. 


III. Procedure 

In order to properly program the system dynamics into the algorithm, the equations of motion must be developed 
by using Newton’s Second Law. These equations are then converted to state space equations in order to input into 
the MATLAB program. This MATLAB program converts these state space equations from the continuous time 
domain to the discrete time domain. Using the pole placement method, this MATLAB program places the poles of 
the system at a desired location based on the phase margin and the damping ratio. Once the poles have been 
positioned, Ackermann’s formula is used to determine the feedback gains of the system at the specified pole 
locations. These feedback gains as well as the discrete state space equations are then programmed into the 
Lab VIEW algorithm and tested. 
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A. Dynamic Systems 

In order to get a better understanding of the Rectilinear Control System as well as the basics of controls theory, 
an algorithm was developed to control a one cart system. This program initiates a step function to make the cart 
move to a specified position or a sine function so the cart can oscillate at a certain amplitude and frequency. 



Figure 2. One Cart System 


Once this program was functional, an algorithm to control a two cart system was created. This algorithm controls the 
position of cart 1 with the added disturbance of a second cart attached by a spring. Similar to the one cart system, 
this program can also implement a step function or a sine function. 



Figure 3. Two Cart System 


The next control scheme that was developed was the lower pendulum system, which consists of the A-51 Pendulum 
Accessory attached to the first cart in a hanging position. This method can be seen in Figure 1. This algorithm is 
used to dampen out the swinging of the pendulum due to a minor disturbance. For instance, once the user gives the 
pendulum a tap, the cart will move in order to stop the swinging of the pendulum. The final control scheme that was 
used was the inverted pendulum system. This system uses the same algorithm as the lower pendulum with one sign 
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change in order to change the direction the cart moves. This algorithm will maintain the pendulum in an inverted 
position by moving the cart and will correct for minor disturbances. 

B. Development of Dynamic Equations 

It was determined that the B state space matrix (force matrix) had to be multiplied by the hardware gain in order 

N 

to convert the output from volts to newtons. The hardware gain was experimentally calculated to be 469 — . 

However, after the Lab VIEW algorithm was tested with the feedback gains, it was discovered that the actual 

469 N 

hardware gain was . This difference might be due to the conversion of the state space matrices from continuous 
time to discrete time. Without dividing the hardware gain by .005, the feedback gains are too high to control the 
system. 

The equations of motion for each system were obtained by using Newton’s Second Law (F = ma) 
and summing the forces of the system in the horizontal direction. Because the plant has multiple degrees of freedom, 
Lagrange’s equations were used to derive the state space representation of each dynamic system. If Q i is called the 
generalized force in the direction of the i th generalized coordinate, T is the kinetic energy and V is the potential 
energy, then Lagrange’s equation is given by 


d ( dT ST dV 

dt dig, dq t dq t 

Expressing the Lagrangian, L = T — V, the equation can be written as: 


d (dL dL 

dt diff dq t 


Q, 


The left side of this equation sums all energy that is conserved in the dynamic system and the right side represents 
the work done by external forces on the system. Solving these Lagrange equations will give the dynamic equations 
the form Mx = Kx + Gu, where M is the mass matrix, K is the dissipation matrix, and G is the shaping matrix. 
Rearranging this equation to the form x — M~ 1 Kx + M~ 1 Gu, where A = M 1 K and B = M~ 1 G. 


1 . One Cart System 
Equation of Motion: 


mx + cx — F(_t ) 


State Space Equations: 


X = Ax + Bli 
y = Cx 
u = —kx 
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Figure 4. One Cart Block Diagram 
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2. Two Cart System 

Equations of Motion: 

m 1 x 1 + + kx 1 — kx 2 — F(t ) 

m 2 x 2 + c 2 x 2 + kx 2 — kx ± = 0 



*2 


> 



Figure 5. Two Cart Block Diagram 


State Space Equations: 

x = Ax + Bu x = [xj x 2 Xj x 2 ] r 
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3. Lower Pendulum System 

Equations of Motion: 

( m 1 + m p )x — m p L6 = — F(t) 
m p L6 — m p Lx — m p gL6 = 0 

State Space Equations: 

Mx = Ky + Gu x = [x 6 x 6>] 
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4. Inverted Pendulum 

Equations of Motion: 

(m 1 + m p )x — m p L9 = F(t ) 
m p L9 — m p Lx + m p gL9 — 0 
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Figure 6. Inverted Pendulum Block Diagram 


State Space Equations: 

Mx = Ky + Gu x = \x 6 x &\ 
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IV. Data and Analysis 

A. Control System Design 

A closed loop control system was used in the development of the Lab VIEW algorithm. A closed loop control 
system uses a measurement from the sensor and compares it to the desired output in order to correct for error 2 . 

Figure eight displays a block diagram of a closed loop control system. Because the two cart system and the 
pendulum systems have multiple degrees of freedom, it was decided that full state feedback would be used to control 
the system. Full state feedback places the closed-loop poles of the system at a desired location. Ackermann’s 
formula is then utilized to determine the feedback gain values. The command in MATLAB for Ackermann’s 
formula is K — acker (A, B, p). Where A and B are the state space matrices and p is the location of the poles. Figure 
seven shows the K matrix values found in each dynamic system. 
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Calculated Feedback Gains for Each System 

One Cart System 

[44.398 0.5228] 

Two Cart System (200 N/m spring) 

[1.1357 21.0286 0.0076 0.764] 

Two Cart System (390 N/m spring) 

[1.3475 24.1461 0.0077 0.6118] 

Two Cart System (830 N/m spring) 

[1.1485 4.8572 0.0076 0.1974] 

Lower Pendulum System 

[128.19 -140.725 20.982 -21.3168] 

Inverted Pendulum System 

[44.28514 -44.1144 -0.13861 0.138383] 


Figure 7. Feedback Gains Using Ackermann’s Formula 


In order to use full state feedback, all states of the system must be known. However, the encoders on the Rectilinear 
Control System only have the capability to measure position. Therefore, a method called state estimation must be 
used in order to determine the velocity states of the system. State estimation is determined using the following 

equation: x — Ax + Bu + L(y — y) — (A — LC — BK)x + Ly . Where A is the system dynamics matrix, B is 
the force matrix , K is the feedback gain matrix, and L is the observer gain matrix. 


Closed Loop Control System 
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Figure 8. Diagram of closed loop control system 


B. Data Analysis 

Figure nine shows the step function input of the one cart system. The first graph is the cart’s position, the second 
graph is the cart’s velocity, and the last graph is the voltage input to the motor. In this experiment, the cart was 
programed to move one centimeter. As you can see the cart overshoots one centimeter and the closed loop control 
system corrects the error and moves the cart back to the correct position. Also, the cart had a relatively quick rising 
time and its steady state error was approximately zero. The amount of overshoot can be controlled by selecting a 
lower set of feedback gains. This requires lowering the phase margin and the damping ratio within the MATLAB 
program. 
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Figure 9. Single Cart Step Response 


Similarly, figure ten shows the one centimeter step response of the two cart system using the three different sized 
springs: 200N/m, 390 N/m, and 830 N/m. The first graph is the position of cart one, the second graph is the position 
of cart two, and the final graph is the voltage input to the motor. This response shows how the added disturbance of 
the second cart attached with a spring disrupts the system. The two cart system takes almost seven milliseconds to 
go into steady state, which is two milliseconds longer than the singe cart system. By taking a look at the individual 
spring constants and how the system responds, we can learn a lot about control systems and how to develop more 
robust control algorithms. For instance, as the spring constant increases, the cart becomes easier to control and the 
overshoot of the cart decreases. Also, due to the increased spring constant the rising time of the system greatly 
increases and the system goes into steady state much quicker. 
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Figure eleven shows the response of the lower pendulum system. The first graph is the cart position, the second 
graph is the pendulum angle, and the last graph is the voltage input to the motor. The pendulum was given an initial 
tap of seven degrees. As a result the cart moved almost two centimeters in order to dampen out the motion. The 
pendulum swing lost three degrees on just the first swing and two more on the next swing. The gains that were used 
in this experiment could not correct the pendulum for anything less than two degrees. This system was used to 
determine how the cart would respond to the unbalance of the pendulum and was used to develop the inverted 
pendulum algorithm. The only difference between the lower pendulum algorithm and the inverted pendulum 
algorithm is the cart moves in the opposite direction to balance the system. 



The inverted pendulum algorithm currently only maintains the pendulum in an inverted state for approximately 
ten seconds. A systems check is currently underway in order to determine the error in the hardware gain. Once the 
correct hardware gain of the system is determined, better feedback gain values will enable the algorithm to maintain 
the pendulum in the inverted position indefinitely. Therefore, no data has been reported for this system. 


V. Conclusions 

In conclusion, by the use of the Rectilinear Control System engineers have access to a low cost demonstration 
test bed that has the ability to simulate a rocket on liftoff. This will enable them to develop more robust and efficient 
control algorithms for launch vehicle systems. Also, this test bed will allow engineers to study slosh dynamics that 
will be experienced in liquid propellant rockets. By observing the two cart system we can conclude that the coupling 
between rocket stages is easier to control and will react faster if it has a greater stiffness constant. The necessity of a 
closed loop control system can be observed in the step responses of each system. The closed loop system enables the 
algorithm to make corrections for error in the motor output. 
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Appendix A: Lab VIEW Program 
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Appendix B: MATLAB Program 

%% Pole Placement for 2-cart system 
% 2 cart continuous to discrete 

% Chris Wilson (06/13/2011) 


clc, clear 


cl=0.014; 
c2=0 . 014 ; 
ml =2 ; 
m2 =2 ; 
k=2 00 ; 


% Friction on cart 1 (N*s/m) 
% Friction on cart 2 (N*s/m) 

% Mass of cart 1 (kg) 

% Mass of cart 2 (kg) 

% Spring between carts (N/m) 


Khw=469/ . 005; %Hardware gain 


%Continuous Model 

F=[0 0 1 0 ; 0 0 0 1 ; -k/ml k/ml -cl /ml 0;k/m2 -k/m2 0 -c2/m2] ; 

G= [ 0 ; 0 ; Khw/ml ; 0 ] ; %B matrix 

C=[l 0 0 0;0 1 0 0]; %output matrix 

T=0.001; %sampling rate 


%A matrix 


%Discrete Model 

[A, B] =c2d (F, G, T) ; %converts to discrete form 

PM=.l; %phase margin 

damp=.9; %damping ratio 

p=damp* [cos (PM*pi/180) +sin (PM*pi/180) *i, cos (PM*pi/180) -sin (PM*pi/180) *i, . . . 

(0 . 01+cos (PM*pi/180) ) +sin (PM*pi/180) *i, (0.01+cos (PM*pi/180) ) - 
sin (PM*pi/180) *i] %pole locations 


K=acker (A, B, p) ; %Developes the K matrix based on the desired pole locations 

%f igure (get_f ig ( ' 2cart place')) 
pzmap (tf ( 1 , poly (p) ) ) 


PM= 1 ; 
damp=0 . 9; 

p=damp* [cos (PM*pi/180) +sin (PM*pi/180) *i, cos (PM*pi/180) -sin (PM*pi/180) *i, . . . 

(0.01+cos (PM*pi/180) ) +sin (PM*pi/180) *i, (0.01+cos (PM*pi/180) ) - 
sin (PM*pi/180) *i] ; 

L=place (A ' , C ' , p) '; 

%f igure (get_fig (' 2cart acker')) 

%pzmap (tf ( 1 , poly (p) ) ) 


u=0; 

q= [ 0 ; 0 ; 0 ; 0 ] ; 
tact=0 ; 
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x= [ 0 ; 0 ; 0 ; 0 ] ; 

xd= [ 1 ; 1 ; 0 ; 0 ] *le-2; 

Nf=100; 

for k=l:Nf %state estimation equations 

y(:,k)=C*x(:,k) ; 
u (k) =-K* (q ( : , k) -xd) ; 

q(:,k+l)=A*q(:,k)+L* (y ( : , k) -C*q ( : , k) ) +B*u (k) ; 
x ( : , k+1 ) =A*x ( : , k) +B*u (k) ; 
tact (k+1) = (k+1) *T; 

end 

figure 

subplot (2 , 1 , 1 ) 

plot (tact (1 :end-l) , x (1, 1 :end-l) *100, tact (1 :end-l) , q (1, 1 :end-l) *100, ' 
' , ' linewidth ' , 2 ) 
subplot (2 , 1,2) 

plot (tact (1 :end-l) , x (2, 1 :end-l) *100, tact (1 :end-l) , q (2, 1 :end-l) *100, ' 

' , ' linewidth ' , 2 ) 

figure 

plot (tact ( 1 : end-1 ) , u) 
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